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PROBLEM TO BE SOLVED: To provide an outside view 
recognition device for a vehicle for quickly and accurately 
recognizing and discriminating whether the other vehicle 
becomes an obstacle to an own vehicle or not and establishing 
proper braking operation. 

SOLUTION: A degree of obstacle recognition as a rate at which 
an object (an obstacle candidate) such as the other vehicle 
detected as an obstacle is calculated by using different 
methods based on the direction of a relative speed vector of 
the obstacle candidate and based on the position of the 
obstacle candidate with respect to the future moving track of 
the own vehicle. Furthermore, weighted average computation is 
carried out such that the degree of obstacle recognition 
calculated by the respective methods is weighted to find a final 
degree of obstacle recognition. 
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* NOTICES * 
i 

JPO and NCIPI are not responsible for any 
damages caused by the use of this translation. 

1 .This document has been translated by computer. So the translation may not reflect the original precisely. 
2.**** shows the word which can not be translated. 
3. In the drawings, any words are not translated. 



CLAIMS 



[Claim(s)] 

[Claim 1] Based on the direction of the relative- velocity vector over the self- vehicle of the failure candidate 
body which may serve as an obstruction to a self- vehicle, whenever [ obstruction recognition / of ** the first 
which computes the rate of recognizing said failure candidate body as an obstruction ] A calculation means, 
Based on the location of said obstruction candidate body to the schedule migration locus of a self- vehicle, 
whenever [ obstruction recognition /of** the second which computes the rate of recognizing said failure 
candidate body as an obstruction ] A calculation means, The first weight function calculation means which 
computes the weight function to said rate which was computed with the calculation means whenever 
[ according to the condition of a self- vehicle and said obstruction candidate body / said obstruction 
recognition / of ** a first ], and to recognize, The second weight function calculation means which computes 
the weight function to said rate which was computed with the calculation means whenever [ according to the 
condition of a self- vehicle and said obstruction candidate body / said obstruction recognition / of ** a 
second ], and to recognize, Said rate which was computed with the calculation means whenever [ said 
obstruction recognition / of ** a first ] and to recognize, and said rate which was computed with the 
calculation means whenever [ said obstruction recognition / of ** a second ] and to recognize, With said 
weight function computed with said first weight function calculation means, and said weight function 
computed with said second weight function calculation means External world recognition equipment for 
vehicles which is equipped with a calculation means whenever [ last obstruction recognition / which 
computes the weighted average of the rate of recognizing said failure candidate body as an obstruction ], and 
is characterized by recognizing the body which serves as an obstruction to a self- vehicle based on the 
calculation result of a calculation means whenever [ said last obstruction recognition ]. 
[Claim 2] External world recognition equipment for vehicles according to claim 1 characterized by 
outputting a small weight function value, so that the relative-velocity magnitude of a vector [ as opposed to 
the self- vehicle of said obstruction candidate body in said first weight function calculation means ] is small. 
[Claim 3] External world recognition equipment for vehicles according to claim 1 or 2 characterized by said 
first weight function calculation means making small the rate that a weight function value changes 
according to time amount progress, so that the magnitude of a component right-angled [ outputting a small 
weight function value ] to the self- vehicle travelling direction of said relative-velocity vector is so small that 
the magnitude of the self- vehicle travelling direction component of the relative- velocity vector over the self- 
vehicle of said obstruction candidate body is small. 

[Claim 4] External world recognition equipment for vehicles of claim 1-3 given in any 1 term with which 
said first weight function calculation means is characterized by outputting a small weight function value, so 
that the elapsed time after detecting said obstruction candidate body is shorter than the time amount which 
the calculation of a relative-velocity vector to the self- vehicle of said obstruction candidate body takes. 
[Claim 5] External world recognition equipment for vehicles of claim 1-4 given in any 1 term characterized 
by outputting a small weight function value, so that the location of said obstruction candidate body [ as 
opposed to the schedule migration locus of a self-vehicle in said second weight function calculation means ] 
is far. 

[Claim 6] External world recognition equipment for vehicles of claim 1-5 given in any 1 term characterized 
by outputting a small weight function value, so that said second weight function calculation means is far 
from the lane where the location of said obstruction candidate body is running the self- vehicle. 
[Claim 7] Said first weight function calculation means and said second weight function calculation means 
Said obstruction candidate body is outside the slow lane of a self-vehicle, and, so that the relative-velocity 
magnitude of a vector to the self- vehicle of said obstruction candidate body is close to the magnitude of the 
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velocity vector of a self- vehicle And external world recognition equipment for vehicles of claim 1-6 given in 
any 1 teian characterized by outputting a small weight function value, so that the location to the self- vehicle 
of said obstruction candidate body is far. 

[Claim 8] It has a selection means further at the automatic-braking initiation time which chooses the 
automatic-braking initiation time of a self- vehicle by the operator. Said first weight function calculation 
means and said second weight function calculation means External world recognition equipment for 
vehicles of claim 1-7 given in any 1 term characterized by outputting a small weight function value, so that 
the time amount which a self- vehicle reaches to the location of said obstruction candidate body is longer 
than the automatic-braking initiation time chosen with the selection means at said automatic-braking 
initiation time. 

[Claim 9] External world recognition equipment for vehicles of claim 1-8 given in any 1 term with which it 
has further an automatic-braking means to brake a self- vehicle based on the calculation result of a 
calculation means whenever [ said last obstruction recognition ], and said automatic-braking means is 
characterized by setting up the target deceleration at the time of automatic braking based on the calculation 
result of a calculation means whenever [ said last obstruction recognition ]. 

[Claim 1 0] External world recognition equipment for vehicles of claim 1 -9 given in any 1 term with which 
said automatic-braking means is characterized by setting up an automatic-braking initiation time based on 
the calculation result of a calculation means whenever [ said last obstruction recognition ]. 
[Claim 1 1] First obstruction candidate body detection means by which a calculation means detects the 
obstruction candidate body which exists at a short distance from a self- vehicle whenever [ said obstruction 
recognition / of ** a first ], It has the third weight function calculation means which outputs a small weight 
function value, so that the location of the detected obstruction candidate body is far from a self-vehicle. 
External world recognition equipment for vehicles of claim 1-10 given in any 1 term characterized by 
amending the calculation result of said first weight function calculation means using the calculation result of 
said third weight function calculation means. 

[Claim 12] Second obstruction candidate body detection means by which a calculation means detects the 
obstruction candidate body which exists in a long distance from a self-vehicle whenever [ said obstruction 
recognition / of ** a first ], It has the fourth weight function calculation means which outputs a small weight 
function value, so that the location of the detected obstruction candidate body is close to a self- vehicle. 
External world recognition equipment for vehicles of claim 1-11 given in any 1 term characterized by 
amending the calculation result of said first weight function calculation means using the calculation result of 
said fourth weight function calculation means. 



[Translation done.] 
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DETAILED DESCRIPTION 



[Detailed Description of the Invention] 
[0001] 

[Field of the Invention] This invention relates to the external world recognition equipment for vehicles for 

recognizing the body which may serve as an obstruction to a self- vehicle. 

[0002] 

[Description of the Prior Art] As this equipment, there are some which are indicated by JP,5-181529,A and 
JP,2000-62555,A, respectively. 

[0003] The former searches for the relative- velocity vector of the detection body to a self- vehicle, performs 
obstruction recognition according to the rate that the production of this vector passes through near a self- 
vehicle, and the latter predicts the future migration locus of a self- vehicle, and it performs obstruction 
recognition according to the distance from the location of the detection body to this migration locus. 
[0004] Drawing 14 and drawing 15 are outline **** things about the situation of obstruction recognition. By 
the road where drawing 14 has a two or more-lane lane here, the detection body with which the low-speed 
vehicle which was running the lane contiguous to the slow lane of a self-vehicle may serve as an obstruction 
like [ in the case of having interrupted the slow lane of a self- vehicle ] in the beginning is distant from the 
travelling direction of a self- vehicle, and the situation that a self- vehicle is approached with time amount 
progress is shown. On the other hand, drawing 1 5 shows the situation that the body (detection body) with a 
large relative velocity with a self-vehicle appeared suddenly, like [ in case a halt vehicle exists in the point 
of a precedence vehicle which secedes from the slow lane of for example, a self- vehicle ]. 
[0005] 

[Problem(s) to be Solved by the Invention] Though it exists in the location distant from the locus of the self- 
vehicle which the detection body predicted in the situation shown in drawing 14 when the relative- velocity 
vector with a detection body had turned to the self- vehicle in order to predict possibility of becoming a 
future obstruction according to the direction of a relative- velocity vector in the case of the former 
equipment, this detection body can be recognized as what has high possibility become an obstruction. Time 
amount part obstruction recognition until it computes relative velocity by being stabilized on the other hand 
in the situation that a body with a big relative velocity appears suddenly ahead [ self- vehicle ] like [ in case a 
halt vehicle exists in the point of a precedence vehicle which secedes from the lane concerned in the 
situation shown in drawing 15, i.e., the lane for example, the self- vehicle is running, ] takes time amount. 
[0006] Moreover, in the situation shown in drawing 1 5 in order to recognize it as an obstruction according 
to the distance in which the detection body is separated from the migration locus of a self- vehicle in the case 
of the latter equipment, since the detection body exists on the migration locus of the future of a self- vehicle, 
this detection body can be recognized as what has high possibility of becoming an obstruction. The body is 
separated from the locus of the predicted self- vehicle in the beginning like [ when the vehicle which was 
running the next lane has, on the other hand, interrupted the situation shown in drawing 14, i.e., the lane for 
example, the self- vehicle is running, ], and it may be recognized as what has low possibility of becoming an 
obstruction at the beginning which detected the detection body in the situation that a self- vehicle is 
approached with time amount progress. Therefore, time amount is taken to recognize an obstruction. 
[0007] This invention was made paying attention to the above-mentioned technical problem, the place made 
into the purpose is not based on an obstruction recognition situation, in case the body which may serve as an 
obstruction to a self-vehicle is recognized, but it is in offering the external world recognition equipment for 
vehicles which enables positive obstruction recognition at high speed. 
[0008] 

[Means for Solving the Problem] For the above-mentioned purpose, the 1 st invention according to claim 1 
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Based on the direction of the relative-velocity vector over the self- vehicle of the failure candidate body 
which mlay serve as an obstruction to a self- vehicle, whenever [ obstruction recognition /of** the first 
which computes the rate of recognizing said failure candidate body as an obstruction ] A calculation means, 
Based on the location of said obstruction candidate body to the schedule migration locus of a self- vehicle, 
whenever [ obstruction recognition / of ** the second which computes the rate of recognizing said failure 
candidate body as an obstruction ] A calculation means, The first weight function calculation means which 
computes the weight function to said rate which was computed with the calculation means whenever 
[ according to the condition of a self-vehicle and said obstruction candidate body / said obstruction 
recognition / of ** a first ], and to recognize, The second weight function calculation means which computes 
the weight function to said rate which was computed with the calculation means whenever [ according to the 
condition of a self- vehicle and said obstruction candidate body / said obstruction recognition / of ** a 
second ], and to recognize, Said rate which was computed with the calculation means whenever [ said 
obstruction recognition / of ** a first ] and to recognize, and said rate which was computed with the 
calculation means whenever [ said obstruction recognition / of ** a second ] and to recognize, With said 
weight function computed with said first weight function calculation means, and said weight function 
computed with said second weight function calculation means It has a calculation means whenever [ last 
obstruction recognition / which computes the weighted average of the rate of recognizing said failure 
candidate body as an obstruction ], and is characterized by recognizing the body which serves as an 
obstruction to a self- vehicle based on the calculation result of a calculation means whenever [ said last 
obstruction recognition ]. 

[0009] In the 1 st invention, the 2nd invention according to claim 2 is characterized by outputting a small 
weight function value, so that the relative-velocity magnitude of a vector [ as opposed to the self- vehicle of 
said obstruction candidate body in said first weight function calculation means ] is small. 
[0010] The 3rd invention according to claim 3 is set to the 1st or 2nd invention. Said first weight function 
calculation means So that the magnitude of the self- vehicle travelling direction component of the relative- 
velocity vector over the self-vehicle of said obstruction candidate body is small It is characterized by 
making small the rate that output a small weight function value, and a weight function value changes 
according to time amount progress, so that the magnitude of a component right-angled to the self-vehicle 
travelling direction of said relative- velocity vector is small. 

[001 1] In either the 1st - the 3rd invention, the 4th invention according to claim 4 is characterized by 
outputting a small weight function value, so that the elapsed time after said first weight function calculation 
means detects said obstruction candidate body is shorter than the time amount which the calculation of a 
relative-velocity vector to the self- vehicle of said obstruction candidate body takes. 

[0012] In either the 1st - the 4th invention, it is characterized by outputting a small weight function value, so 
that the 5th invention according to claim 5 has the far location of said obstruction candidate body [ as 
opposed to the schedule migration locus of a self- vehicle in said second weight function calculation means ]. 

[0013] In either the 1st - the 5th invention, it is characterized by outputting a small weight function value, so 
that said second weight function calculation means of the 6th invention according to claim 6 is far from the 
lane where the location of said obstruction candidate body is running the self-vehicle. 
[0014] The 7th invention according to claim 7 is set to either the 1st - the 6th invention. Said first weight 
function calculation means and said second weight function calculation means Said obstruction candidate 
body is outside the slow lane of a self-vehicle, and, so that the relative-velocity magnitude of a vector to the 
self- vehicle of said obstruction candidate body is close to the magnitude of the velocity vector of a self- 
vehicle And it is characterized by outputting a small weight function value, so that the location to the self- 
vehicle of said obstruction candidate body is far. 

[0015] The 8th invention according to claim 8 is further equipped with a selection means in either the 1st - 
the 7th invention at the automatic-braking initiation time which chooses the automatic-braking initiation 
time of a self-vehicle by the operator. Said first weight function calculation means and said second weight 
function calculation means are characterized by the time amount which a self- vehicle reaches to the location 
of said obstruction candidate body outputting a small weight function value, so that it is longer than the 
automatic-braking initiation time chosen with the selection means at said automatic-braking initiation time. 
[0016] The 9th invention according to claim 9 is further equipped with an automatic-braking means to brake 
a self- vehicle based on the calculation result of a calculation means whenever [ said last obstruction 
recognition ], in either the 1st - the 8th invention, and said automatic-braking means is characterized by 
setting up the target deceleration at the time of automatic braking based on the calculation result of a 
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calculation means whenever [ said last obstruction recognition ]. 

[0017] The 10th invention according to claim 10 is characterized by said automatic-braking means setting 
up an automatic-braking initiation time based on the calculation result of a calculation means whenever 
[ said last obstruction recognition ] in either the 1 st - the 9th invention. 

[0018] The 1 1th invention according to claim 1 1 is set to either the 1st - the 10th invention. First obstruction 
candidate body detection means by which a calculation means detects the obstruction candidate body which 
exists at a short distance from a self- vehicle whenever [ said obstruction recognition / of ** a first ], It has 
the third weight function calculation means which outputs a small weight function value, and is 
characterized by amending the calculation result of said first weight function calculation means using the 
calculation result of said third weight function calculation means, so that the location of the detected 
obstruction candidate body is far from a self-vehicle. 

[0019] The 12th invention according to claim 12 is set to either the 1st - the 1 1th invention. Second 
obstruction candidate body detection means by which a calculation means detects the obstruction candidate 
body which exists in a long distance from a self- vehicle whenever [ said obstruction recognition / of ** a 
first ], It has the fourth weight function calculation means which outputs a small weight function value, and 
is characterized by amending the calculation result of said first weight function calculation means using the 
calculation result of said fourth weight function calculation means, so that the location of the detected 
obstruction candidate body is close to a self- vehicle. 
[0020] 

[Effect of the Invention] According to the 1 st invention, whenever [ obstruction recognition / which is the 
rate to the body (failure candidate body) which may serve as a detected obstruction recognized as an 
obstruction ] is computed, respectively by the approach based on the direction of the relative- velocity vector 
of the failure candidate body concerned, and two or more approaches approach **s based on the location of 
the failure candidate body to the future migration locus of a self- vehicle differ. And the function value 
which changes according to a transit situation is defined as a value of a weight function in order to express 
the validity to each whenever [ each obstruction recognition / which was computed ]. By multiplying 
whenever [ these obstructions recognition ] by said weight function value furthermore, and weight averaging 
the acquired value, it asks for whenever [ with the detected failure candidate body / final obstruction 
recognition ], and recognizes whether it becomes an obstruction. Therefore, exact and high-speed 
obstruction recognition according to relative velocity, a location, etc. of a transit situation or an obstruction 
can be performed. 

[0021] In order [ according to the 2nd invention ] to set up the value of the weight function computed based 
on the direction of the relative-velocity vector of an obstruction candidate body and a self- vehicle so that it 
may become so small that said relative-velocity magnitude of a vector is small, being thought as important 
of whenever [ obstruction recognition / which is computed in the low situation of a S/N ratio ] is lost, and it 
becomes possible to, raise the precision of whenever [ obstruction recognition ] as a result. 
[0022] According to the 3rd invention, the value of the weight function computed based on the direction of 
the relative-velocity vector of an obstruction candidate body and a self-vehicle In order to set up so that 
sensibility may become low about the component of the cross direction rather than the component of the 
direction of the distance between two cars of said relative-velocity vector, When a noise joins the relative- 
velocity component of the cross direction with a comparatively low precision, whenever [ obstruction 
recognition / which is computed ] becomes is hard to be thought as important, and it becomes possible to, 
raise the precision of whenever [ obstruction recognition ] as a result. 

[0023] According to the 4th invention, about the value of the 1st and 2nd weight functions to compute When 
the time amount after an obstruction candidate body newly appears to time amount until the relative-velocity 
vector of an obstruction candidate body and a self- vehicle is stabilized and is searched for is short It is small 
in the value of the 1 st weight function, and in order to, enlarge the value of the 2nd weight function on the 
other hand, in a situation immediately after an obstruction candidate body appears, it becomes possible to 
raise the precision of whenever [ obstruction recognition ]. 

[0024] Since it becomes such a small value that the location of an obstruction candidate body exists far 
away to the migration locus of the self- vehicle which the 2nd weight function predicts according to the 5th 
invention, the distance between obstruction candidate bodies is separated at first, and it becomes possible to 
raise the precision of whenever [ obstruction recognition ] in the situation that an obstruction candidate body 
approaches with time amount. 

[0025] According to the 6th invention, in order to take such a small value that the location of an obstruction 
candidate body is far from the slow lane of a self- vehicle, it becomes possible to raise the precision of 
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whenever [ obstruction recognition ] of the 2nd weight function. 

[0026] According to the 7th invention, possibility that the detected obstruction candidate body has stopped 
is high, and possibility of being located outside the slow lane of a self- vehicle is high, and when the relative 
distance between self- vehicles is still larger, it is supposed that the value of the 1st and 2nd weight functions 
will both be made small. Therefore, when the detected obstruction candidate body is a location near the edge 
of a lane like a traffic sign and exists far away, it becomes possible to raise the precision of whenever 
[ obstruction recognition ]. 

[0027] The 1st and 2nd weight function values are low made into things, so that the time amount predicted 
that a self- vehicle reaches to the location of an obstruction candidate body is long as compared with the 
automatic-braking initiation time (timing of brakes operation) set up by the operator according to the 8th 
invention. Therefore, the detection range to the body which is far away in time will be restricted, and while 
becoming possible to raise the precision of whenever [ over such a body / obstruction recognition ], it 
becomes possible to set up the automatic damping characteristic suitable for liking of an operator by the 
operator. 

[0028] According to the 9th invention, since the result computed by the calculation means whenever [ last 
obstruction recognition ] is set to one of the elements for computing target deceleration in an automatic- 
braking means, the strong brake will not work to the low body of possibility of becoming an obstruction, 
and suitable automatic braking according to whenever [ obstruction recognition ] becomes possible. 
[0029] Since the result computed by the calculation means whenever [ last obstruction recognition ] is set to 
one of the elements for determining control initiation timing in an automatic-braking-system control system 
according to the 10th invention, it becomes possible to perform correspondence of not performing strong 
brake actuation or performing weaker brake actuation a little early immediately to the low body of 
possibility of becoming an obstruction, by the brake control-system side. 

[0030] According to the 1 1th and 12th invention, the body which exists far away from the circumference of 
a self- vehicle or a self- vehicle is detected, respectively, and it is supposed that the 1st or 2nd weight function 
value will be amended according to the location of the body concerned. It becomes possible to ask for 
whenever [ objective obstruction recognition ] more correctly by it corresponding to an attach point, a 
weather situation, etc. of a device which detect a body. 

[003 1] In the external world recognition equipment for vehicles by this invention, a calculation means is 
established whenever [ obstruction recognition / from which a property differs ], and the weight function to 
whenever [ obstruction recognition / which was computed in the calculation means whenever / each 
obstruction recognition ] is set up. It is supposed with whenever [ each / these / obstruction recognition ], 
and a corresponding weight function that it asks for whenever [ final obstruction recognition ]. 
[0032] It is based in the direction of the relative- velocity vector over a self- vehicle as a calculation means 
whenever [ obstruction recognition ]. the approach of computing the rate of recognizing said failure 
candidate body as an obstruction — and It is based on the location of said obstruction candidate body to the 
schedule migration locus of a self- vehicle. When two of the approaches of computing the rate of recognizing 
said failure candidate body as an obstruction are used, for example, the low-speed vehicle which was 
running the lane contiguous to the slow lane of a self- vehicle as shown in drawing 14 like [ in the case of 
having interrupted the slow lane of a self- vehicle ] In the situation that the detection body which may serve 
as an obstruction is distant from the travelling direction of a self- vehicle in the beginning, and a self- vehicle 
is approached with time amount progress By performing calculation of whenever [ obstruction recognition / 
which thought the former approach as important ], a detection body becomes possible [ getting to know 
possibility of becoming an obstruction, in a quicker phase ]. 

[0033] Moreover, a detection body becomes possible [ getting to know possibility become an obstruction, in 
a quicker phase ] in the lane the self- vehicle as shown in drawing 1 5 is running by performing calculation of 
whenever [ obstruction recognition / which thought the latter approach as important in the situation that a 
body with a big relative velocity appears suddenly ahead / self- vehicle ] like [ in case a halt vehicle exists in 
the point of a precedence vehicle which secedes from the lane concerned ]. 

[0034] In calculation of whenever [ this obstruction recognition ], the value of the weight function 
corresponding to each calculation result in whether which calculation approach should be thought as 
important and recognized to the calculation result of a calculation means according to a situation whenever 
[ obstruction recognition / from which a property differs ] is changed, and it judges by taking the weighted 
average of each calculation result and a weight function value. An obstruction can be recognized now 
correctly and quickly to a wide range situation by it. 
[0035] 
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[Embodiment of the Invention] Hereafter, the suitable operation gestalt of this invention is explained with 
reference to a drawing. 

[0036] Drawing 1 is an outline **** block diagram about the basic configuration of the external world 
recognition equipment for vehicles by this invention. The equipment of illustration by the self-vehicle 
quantity of state output section 1 02 which detects and outputs quantity of states which detect and output the 
location of the obstruction candidate who exists around a self- vehicle, such as a rate of the obstruction 
candidate location output section 101 and a self- vehicle, and approach different, respectively Possibility that 
the obstruction candidate who detected will become an obstruction Whenever [ obstruction recognition / 
which is shown ] Whenever [ obstruction recognition /of** the first to calculate ] The calculation section 
103 Whenever [ first weight function calculation section / which computes the weight function value for 
carrying out weighting to the calculation section 1 04 and the value computed in the calculation section 
whenever / these obstructions recognition / whenever / obstruction recognition / of ** a second / 105 and 
second weight function calculation section 106, and these obstructions recognition ] And the calculation 
section And it has the calculation section 1 07 whenever [ last obstruction recognition / which asks for 
whenever / final obstruction recognition / based on the value outputted, respectively from the weight 
function calculation section ]. 

[0037] Drawing 2 is an outline **** block diagram about the configuration of the whole system using the 
external world recognition equipment for vehicles by this invention. The system of illustration is equipped 
with the transit control unit 201, a laser radar 202, the radar processor 203, CCD camera 204, an image 
processing system 205, vehicle speed detection equipment 206, steering angle detection equipment 207, the 
automatic brake operating unit 208, and the negative pressure brake booster 209. 

[0038] It is irradiated a laser radar 202 scanning a laser beam to the travelling direction of a vehicle, and the 
body (obstruction candidate body) with which the radar processor 203 may serve as an obstruction based on 
the result is extracted. In addition, in the radar processor 203, calculation of the two-dimensional coordinate 
value which makes a self- vehicle a zero is also performed to one or more obstruction candidate bodies. 
[0039] On the other hand, CCD camera 204 also picturizes the situation ahead of a vehicle, and the result is 
transmitted to an image processing system 205. This image processing system 205 can also recognize 
whether an obstruction candidate body exists on the slow lane of a self- vehicle, if the location of the two- 
dimensional coordinate value of the obstruction candidate body which could detect the white line which 
divides the slow lane of a self-vehicle and an adjoining lane, and was computed with the radar processor 
203, i.e., an obstruction candidate body, is in any of the inside and an outside to the detected white line or 
puts in another way. 

[0040] The data outputted from the radar processor 203 and an image processing system 205 are transmitted 
to the transit control unit 201. Moreover, the data outputted from each of vehicle speed detection equipment 
206 and steering angle detection equipment 207 are also transmitted to the transit control unit 201. The 
transit control device 201 takes the configuration shown in drawing 1, searches for collision possibility with 
an obstruction based on the data transmitted from each [ these ] equipment, and outputs the signal for the 
processing according to the result (automatic-braking-system signal). 

[0041] The output signal from the transit control device 201 is sent to the automatic brake operating unit 
208. The automatic brake operating unit 208 is connected with the negative pressure brake booster 209 
formed in the vehicle order ring, and brake control of a vehicle is performed by impressing the damping 
force command electrical potential difference from the automatic brake operating unit 208 to the solenoid 
valve which each negative pressure brake booster 209 does not illustrate. 

[0042] Drawing 3 is an outline **** Fig. about the calculation procedure of whenever [ obstruction 
recognition-with transit control unit 201 ]. In the calculation section 103, it asks [ whenever / obstruction 
recognition / of ** a first / whenever / obstruction recognition / of ** a first / whenever / obstruction 
recognition / of Rl and ** a second / the R2 and first weight function calculation section 105 / the first 
weight function Wl and the second weight function calculation section 106 ] for the second weight function 
W2 whenever [ obstruction recognition / of ** a second ] by the calculation section 104, respectively. 
Subsequently, product R2xW2 of R2 and the second weight function W2 are calculated [ whenever / 
obstruction recognition / of ** a first ] whenever [ product RlxWl of Rl and first weight function Wl, and 
obstruction recognition / of ** a second ]. And at the calculation section 107, it is a weighted average 
[several 1] from these values whenever [ last obstruction recognition ]. (RlxWl+R2xW2) /(W1+W2) 
Eye **** and its value are considered as whenever [ final obstruction recognition ]. 
[0043] Drawing 4 is a flow chart which shows the procedure which asks for whenever [ obstruction 
recognition ] based on the ranging data from a laser radar 202 in the external world recognition equipment 

http://www4.ipdl.ncipi.go.jp/cgi-bin/tran_web_cgi_ejje 3/2/2006 



JP,2002-225656,A [DETAILED DESCRIPTION] 



Page 6 of 10 



for vehicles by this invention. Hereafter, the procedure is explained. In addition, suppose that this processing 
is performed every 10ms here. 

[0044] At step 301, the positional information (a lateral displacement, yaw angle) of the self- vehicle to the 
white line of the slow lane of the automatic brakes operation timing which the operator besides the rate data 
of the self-vehicle from the vehicle parameter 206, i.e., vehicle speed detection equipment, and the steering 
angle data of the self- vehicle from steering angle detection equipment 207 was arbitrary, and chose, and a 
self- vehicle, and the configuration (curvature) of a white line are inputted first, respectively. 
[0045] At continuing step 302, data smoothing of the vehicle speed and the steering angle which were 
inputted at step 301 is performed using the low pass filter shown by the degree type. 

[Equation 2] y=beta Z/(Z-alpha) -ubeta=l -alpha — Z shows the variable which substitutes the vehicle speed 
or the steering angle into which u was inputted at step 301 here, and a time amount progress operator and y 
show the value after smoothing, respectively. Moreover, alpha is less than one positive number defined 
beforehand. 

[0046] At step 303, if it judges and updates whether the output data from a laser radar 202 are updated, and 
progresses to step 304 and is not updated, it progresses to step 308. In addition, renewal of the output data 
from a laser radar 202 shall be performed every 1 00ms here. 

[0047] At step 304, the location in the two-dimensional system of coordinates of two or more obstruction 
candidate bodies extracted from the result scanned with the laser radar 202 is read, and a relative- velocity 
vector is calculated from the coordinate value of the location of the read obstruction candidate body using 
the transfer function discretized with the sampling period for 1 00ms like a degree type in continuing step 
305. 

[Equation 3] G(Z)=(cZ2-c)/(Z2-aZ+b) 

Here, Z is a progress operator and multipliers a, b, and c are positive numbers. In addition, when change of 
ranging situations, such as disappearance of an obstruction candidate body and prehension of a new 
obstruction candidate body, arises, the past value of all the I/O variables of an upper type is transposed to 
the current value. 

[0048] At step 306, the location data of the obstruction candidate body read at step 304 were the location 
which did not exist at all till then, i.e., it judges whether the obstruction candidate body newly appeared. 
Here, when it is judged that the obstruction candidate body newly appeared, it progresses to step 307, and 
when that is not right, it progresses to step 308. 

[0049] the ID number assigned at step 307 for each [ which was read at step 304 ] obstruction candidate 
body of every — (— the variable Tapr showing the time amount after each obstruction candidate body 
prepared in every i) appears [i] is reset to 0. 

[0050] At step 308, it asks for yaw rate and slip-angle beta by the degree type using the vehicle speed (Vsp) 
which performed data smoothing at step 302, and the value of a steering angle (delta). 
[Equation 4] 

[x] ID=000003 



Here, revolution moment of inertia [ in / Kr / the weight of a car body, and / respectively / respectively / Kf 
and Kr / Variable /ml the cornering power of an order ring tire, and If and lr, and / in I / a vehicle core ] and 
s show the Laplacian operator. [ the distance from a front wheel to a center of gravity and the distance from 
a rear wheel to a center of gravity ] In addition, although the yaw rate and the slip angle are computed here 
using a two-flower model, it is good also as using the data inputted from steering angle detection equipment 
207 as a direct yaw rate value, and asking for slip-angle beta from the ratio of the detection value in a front 
backward acceleration sensor and a longitudinal direction acceleration sensor (not shown [ both ]). 
[0051] At step 309, the yaw rate for which it asked at step 308, a slip angle, and the vehicle speed and the 
steering angle which were searched for at step 302 are used, and the future migration locus of a self- vehicle 
is predicted as a value of TR R of a self- vehicle from a degree type. 
[Equation 5] 

[x] ID=000004 



[0052] It is a degree type [several 6] about the direction of the relative-position vector of the location of the 
obstruction candidate body read at step 304 in step 3 10 to an obstruction candidate body. It is a degree type 

http : // w w w4 . ipdl . ncipi . go . j p/cgi -bin/tr an_web_cgi_ej j e 3 /2/2 006 



JP,2002-225656,A [DETAILED DESCRIPTION] 



Page 7 of 10 



[several 7] about the direction of the relative-position vector of the edge of the width of face of the 
obstruction candidate body [ arctan / (obst_x[i]/obst_y [i]) / direction_C[i] =] to the edge of the breadth of a 
car of a self- vehicle. It asks, respectively from direction_L[i] =arctan (obst_x[i]+obj_width [i] /2+w/2) 
(/obst_y [i]). Here, in the y-coordinate of an obstruction candidate body, and variable objwidth [i], the 
width of face of an obstruction candidate body and Variable w express [ Variable i / the ID number of an 
obstruction candidate body, and variable obst_x [i] / the x-coordinate of an obstruction candidate body, and 
variable obst_y [i] ] the width of face of a self- vehicle, respectively. 

[0053] Next, it is a degree type [several 8] about the direction of the relative- velocity vector of the 
obstruction candidate body to a self-vehicle. It asks from direction[i] =arctan (rVx [i]/rVy [i]). Then, it is a 
degree type [several 9] about the value of possibility that whenever [ whenever / obstruction recognition / 
based on the direction of a relative-velocity vector ] (whenever [ obstruction recognition / of ** a first ]), 
i.e., an obstruction candidate body, can serve as an obstruction from the value calculated by each above- 
mentioned formula for a self-vehicle. Recog_rVxy= (it asks by -0.2/fabs(direction_L[i]-direction_C [i]) 
*fabs(direction_C[i]-direction [i])+1.0.) Variables rVx and rVy show the value of the cross direction of 
relative velocity, and the direction of the distance between two cars calculated at step 305, and Function fabs 
(x) is a function which calculates the absolute value of Argument x here. Moreover, variable Recog_rVxy 
shows that possibility of taking the value of 0.8-1.0 when an obstruction candidate body may serve as an 
obstruction for a self-vehicle, and becoming an obstruction, so that a value is small is low. 
[0054] At step 31 1, it asks for whenever [ obstruction recognition ] (whenever [ obstruction recognition / of 
** a second ]) by the degree type based on the location of the obstruction candidate body to the future 
migration locus R of the self-vehicle computed at step 309. 

[Equation 10] Recog_Dist=(-0.2/w/2) *fabs(hypot(obst_y [i], (obst_x[i]-R))-R)+1.0 - here, Function hypot 
(pi, p2) calculates one (pl2+p22) half of values from arguments pi and p2. In addition, variable 
Recog_Dist also shows that possibility of taking the value of 0.8-1 .0 when an obstruction candidate body 
may serve as an obstruction for a self-vehicle, and becoming an obstruction, so that a value is small is low. 
[0055] At step 312, it asks for the first weight function to whenever [ obstruction recognition / of** the first 
calculated at step 310 ], and the second weight function to whenever [ obstruction recognition /of** the 
second calculated at step 311] with the procedure explained below, respectively. 

[0056] First, the mean value tmpW 1_1 of the first weight function is calculated by the degree type from the 
magnitude of the relative- velocity vectors rVx and rVy searched for at step 305. 

[Equation 11] tmpWl l=funcl (fabs (rVx), fabs (rVy)) — fund is a function which has a property as shown 
in drawing 5, when a relative-velocity vector is small, the value of the first weight function is made low, and 
it is made for the sensibility to the relative velocity of the cross direction to become low here compared with 
the relative velocity of the direction of the distance between two cars In addition, although the value of the 
first weight function is made small as a relative- velocity vector becomes small here, it may be made to 
enlarge the second weight function relatively. 

[0057] Moreover, another mean value tmpW 12 of the first weight function is calculated by the degree 
type. 

[Equation 12] tmpWl_2=func2 (Tapr [i], Tds) — func2 is a function which has a property as shown in 
drawing 6, and Variable Tds expresses time amount until it can compute by a relative- velocity vector being 
stabilized with the transfer function in previous step 305, and it makes it the constant value for 400ms here, 
for example. In addition, although the value of the first weight function is made small in the situation which 
between does not have, either after an obstruction candidate body appears in this example, the value of the 
second weight function may be enlarged relatively. 

[0058] Next, one mean value tmpW 2_1 of the second weight function is calculated by the degree type. 
[Equation 13] tmpW2_l=func3 (fabs (hypot(obst_y [i], (obst_[x]-R))-R) - here, func3 is a function which 
has a property as shown in drawing 7 .) In addition, although an obstruction candidate body makes the value 
of the second weight function small here so that it is located far away from the migration locus of the self- 
vehicle to predict, it is good also as enlarging the value of the second weight function relatively. 
[0059] Then, the mean value tmpW 12_1 over the first and the second weight function is calculated from a 
degree type. 

[Equation 14] tmpW12_l=func4(hypot (rVy [i], rVx [i])) *func5 (obs_io, hypot (obst__y [i], obst_x [i])) - 
however obs_io=obs_pos-hypot(obst_y [i], obst_x [i])-hobs_pos=hypot (rhocos(y)-obst_x [i]) ((rhosin(y) 
obst_y[i])) — here func4 and func5 are functions which have a property as shown in drawing 8 and drawing 
9, respectively. Variable rho is radius of curvature which shows the white line configuration in the slow lane 
searched for at step 301 (here, a right curve is made forward). The distance (here, right-hand side is made 
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forward) from the center of both white lines [ in / in h / the slow lane of a self- vehicle ] on either side to a 
self-vehicle and y are the yaw angles of the self- vehicle to a white line (here, facing the right is made 
forward). A small value will be taken, so that possibility that the obstruction candidate body has stopped is 
high, i.e., the magnitude of relative velocity is large, and the value of tmpW 121 of possibility that the 
obstruction candidate body exists outside the slow lane of a self- vehicle is higher than this and a relative 
position with the obstruction candidate body is still further. 

[0060] Furthermore, another mean value tmpW 12_2 over the first and the second weight function is 
calculated from a degree type. 

[Equation 15] tmpW12_2=func6 (Tc, obs t_y [i]/rVy [i]) — func6 is a function which has a property as 
shown in drawing 10, and an operator shows the control initiation timing which is liked, and can be come 
out of and chosen, and sets Variable Tc to **:1.8sec, inside:2.4sec, and long :3.0sec, for example by the 
three-stage here. 

[0061] From each value calculated as mentioned above, weight functions Wl and W2 are calculated from a 
degree type, respectively. 

[Equation 16] Wl=tmpWl_l *tmpWl_2*tmpW12_l *tmpW 12_2W2=tmpW2_l *tmpW12_l *tmpW 12_2 
[0062] And at step 313, the contact possibility of whenever [ final obstruction recognition ], i.e., an 
obstruction candidate body, is calculated by the degree type (weighted average) from the value of whenever 
[ obstruction recognition / which was searched for at step 310 and step 311, respectively ], and the value of 
the weight function for which it asked at step 312. 
[Equation 17] 

Recog=(Recog_rVxy*Wl+Recog_Dist*W2)/(Wl+W2) [0063] The value of the past required in order to 
perform the smoothing operation in step 302 and the transfer function operation in step 305 is updated at the 
last, and the value of the variable Tapr to each obstruction candidate body [i] is made to increase to it only 
by the minute at step 314 for 10ms which is the sampling time. 

[0064] Exact and high-speed obstruction recognition is enabled by setting up calculation of whenever [ two 
or more obstruction recognition ], and two or more weight functions which corresponded to these, 
respectively, and scanning a weight function appropriately with the above procedure, according to a 
situation. 

[0065] Drawing 1 1 is a flow chart which shows the procedure which asks for whenever [ at the time of using 
two or more means by which the principles which detect a laser radar 202 (refer to drawing 2) and an 
obstruction candidate body like CCD camera 204 differ / obstruction recognition ] in the external world 
recognition equipment for vehicles by this invention. Hereafter, the procedure is explained. In addition, 
suppose that it processes every 10ms also here. 

[0066] First, at step 501, it judges whether the output data of a CCD camera are updated, and if are updated, 
and not updated, it will progress to step 502 to step 506. 

[0067] At step 502, the location in the two-dimensional system of coordinates of two or more obstruction 
candidate bodies extracted from the depth map result picturized with the CCD camera is read. At continuing 
step 503, a relative-velocity vector is searched for from the location of each read obstruction candidate body 
using the transfer function discretized with the sampling period for 20ms. In addition, the transfer function 
used here is the same as the transfer function used at step 305 of the flow chart shown in drawing 4. 
[0068] At step 504, the location of the obstruction candidate body read at step 502 was the location which 
did not exist at all till then, i.e., it judges whether the obstruction candidate body newly appeared. Here, 
when it is judged that the obstruction candidate body newly appeared, it progresses to step 505, and when 
that is not right, it progresses to step 506. 

[0069] the ID number assigned at step 505 for each [ which was read at step 502 ] obstruction candidate 
body of every — (— variable Tapr CMR [i] showing the time amount after each obstruction candidate body 
appears prepared in every i) is reset to 0. Since the processing in continuing step 506 - step 510 is the same 
as that of steps 303-307 of drawing 4, explanation is omitted. 

[0070] At step 51 1, it asks for whenever [ obstruction recognition / of ** a first ] based on the direction of 
the relative- velocity vector by the image pick-up data of a CCD camera for which it asked at step 503. Since 
the operation here is the same as that of step 310 of drawing 4, explanation is omitted. In addition, the value 
of whenever [ corresponding to each obstruction candidate body called for here / obstruction recognition / of 
** a first ] is assigned to variable RecogCMR [i]. 

[0071] At step 512, it asks for whenever [ obstruction recognition /of** a first ] based on the direction of 
the relative- velocity vector by the scan data of a laser radar 202 for which it asked at step 508. Since it is the 
same as that of step 3 1 0 of drawing 4, an operation here also omits explanation. In addition, the value of 
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whenever [ corresponding to each obstruction candidate body called for here / obstruction recognition / of 
*.* a first ] is assigned to variable Recog__LR [i]. 

[0072] At step 513, it asks for the third weight function to whenever [ obstruction recognition / of ** the 
first calculated at step 511], and the fourth weight function to whenever [ obstruction recognition / of ** the 
first calculated at step 512 ] with the procedure explained below, respectively. 

[0073] First, the mean value tmpW 11 of the third weight function [i] and the mean value tmpW 2_1 of the 
fourth weight function [i] are calculated from the value of the relative- velocity vector searched for at step 
503, respectively. In addition, calculation of these values uses the same formula as step 312 of drawing 4. 
[0074] Next, another mean value tmpW 1_2 of the third weight function [i] is calculated by the degree type. 
[Equation 18] tmpWl_2[i] =func2 (Tapr_CMR [i], Tds_CMR) - here, func2 is the same as the function 
used at step 312 of the procedure of drawing 4. In addition, variable TdsCMR is a transfer function [several 
19] from the image pick-up result of CCD camera 204. G(Z)=(cZ2-c)/(Z2-aZ+b) 

Time amount until it can compute by it being alike and a relative- velocity vector being stabilized more is 
expressed, and the constant value for 40ms is taken here. 

[0075] Similarly, another mean value tmpW 2_2 of the fourth weight function [i] is calculated by the degree 
type. 

[Equation 20] tmpW2_2[i] =func2 (Tapr LR [i], TdsLR) - in addition, variable TdsLR expresses time 
amount until it can compute by a relative- velocity vector being stabilized with the upper transfer function 
from the scan result of a laser radar 202 (refer to drawing 2). Moreover, a function ftinc2 is the same 
function as the thing in the procedure of drawing 4. 

[0076] Here, although an obstruction candidate body can detect in a laser radar 202, in existing in the distant 
place which cannot be detected in a CCD camera, it calculates the mean value of the third and fourth weight 
functions by the degree type. 

[Equation 21] Although tmpWl_3[i] =1, tmpW2_3[i] =0, and an obstruction candidate body can detect in 

CCD camera 204, in existing in the wide angle location which cannot be detected in a laser radar 202, it 

calculates the mean value of the third and fourth weight functions by the degree type. 

[Equation 22] tmpWl_4[i] =0 and tmpW2_4[i] = - 1 [0077] From the value calculated from the above 

procedure, the third and fourth weight functions Wl corresponding to each obstruction candidate body [i] 

and W2 [i] are calculated by the degree type, respectively. 

[Equation 23] 

Wl[i] =tmpWl_J[i] *tmpW l_2[i] *tmpWl_3[i] *tmpW 1_4 - [i] W2[i] =tmpW2_l[i] *tmpW - 2_2[i] 
*tmpW2_3[i] *tmpW 2_4 — [i [0078]] At step 514, it asks for whenever [ final obstruction recognition ] 
using a degree type (weighted average) from the value of whenever [ obstruction recognition / which was 
searched for, respectively ], and the value of the weight function for which it asked at step 513 by step 511 
and step 512. 

[Equation 24] Recog [i] =(Recog_CMR[i] *Wl[i]+Recog_LR[i] *W2)/(W1+W2) [0079] The value of the 
past required in order to perform a transfer function operation etc. is updated, and the value of variable 
Tapr_CMR [i] and Tapr_LR [i] to each obstruction candidate body is made to increase only by the minute at 
step 5 1 5 for 1 0ms which is the sampling time. 

[0.080] Furthermore at step 516, the target deceleration in the automatic brake operating unit 208 (refer to 
drawing 2) is searched for by the degree type based on whenever [ final obstruction recognition / which was 
searched for at step 514 ]. 

[Equation 25] alphabrk=Recog [i] **** shall show the rate of a precedence vehicle, Vsp shall show the rate 
of a self-vehicle 2* (****2-Vsp2) / (2* (L-Lt)) here, and the value of **** shall be calculated from the sum 
of relative velocity rVy and Vsp. Moreover, Lt shows the target distance between two cars for the distance 
between two cars which L detected, for example, it is [Equation 26]. It sets up with Lt=1.5*Vsp+4. 
[0081] Thus, based on the value of calculated alphabrk, automatic-braking-system actuation is made by the 
automatic brake operating unit 208 (refer to drawing 2). Consequently, automatic-braking-system actuation 
in consideration of whenever [ obstruction recognition ] will be performed, it becomes loose automatic- 
braking-system actuation to the body which cannot judge easily whether it can become an obstruction or that 
is not right, and the brake actuation at the time of incorrect recognition can be eased. 

[0082] Moreover, based on whenever [ obstruction recognition / which was searched for at step 514 ], it asks 
for automatic-braking-system control initiation timing by the degree type. 

[Equation 27] Tbrk=func7 (Recog [i]) — here, func7 is a function which has a property like drawing 12. 
[0083] Furthermore, when the conditions of a degree type are satisfied, above target decelerating alphabrk is 
outputted to the automatic brake operating unit 208. 
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[Equation 28] L/(****-Vsp) <Tbrk - the left part of a formula shows the time amount to the collision with 
an obstruction candidate body here. 

[0084] In this way, based on the value of calculated Tbrk, the initiation timing of automatic-braking-system 
actuation is changed. Consequently, automatic-braking-system actuation in consideration of whenever 
[ obstruction recognition ] will be performed, early automatic-braking-system actuation is performed to the 
body which cannot judge easily whether it can become an obstruction or that is not right, i.e., the time 
amount to a collision will be prolonged and brake actuation can be eased. 

[0085] In addition, if the property of a function func7 is set up like drawing 13, after initiation of automatic- 
braking-system actuation will become slow and an operator will recognize an obstruction candidate body by 
it, it becomes possible to lengthen time amount which examines whether it can become an actual 
obstruction. 

[Translation done.] 
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1 

[BBBBCDBBl 

zmmmmvift<D. smmizpftzmmm** mu© 

*W^*BmT*B-©BB*lBB«» 

i mB©^sf£S!i»iB c«-r -s mzmmwimffi'MtecxiL 

glcg^'v*. BEB&£ffft{*eB8ft£ UTBtt-TS 
aBBfc«fctfBERS%B«ia#©ttBlcjESi;;t. BE 

a*Bfc«fctfBEWs&BB%tt©i*agicjBi;fc. be 

B=©BSBeKftBtti¥BTBtt L/tBEBBT*ffl 

BEB-©BB%BBs»£tt#s-egdi utBEisB-r 

wcBifr*w*i. BEB-©B*KttBB¥«-rB 
tfcufcBEfi*wi&<t. BEB=©B*BttBa*«T 
nta ufc«iEB*H»i c«t u . nEP»BttBtt*«n 
stt-t oxB»r*H$oiiDB¥^«iiair*«»B» 

BEBBBBBBBBBdj^BoBibBB ic*-o*i \x. 

tts, bbb*#?bsibh. 

[BBB2] BEB-©B*BBSaS¥8#, ttK» 

wv>tiii&%m(D&mmiz*r?z>&*imm'<9 Mb©** 
salens. 'hst»B*H»Bfcm^-r*cd:«»a 
<t-r*. a*si EB©«BB;tBSKBB. 

[BB&3] BEB-©a*B£Wf!il¥Bj!^ BEf§ 

Bflm*BB#©**3a*/hsos, /ji£ob*b&b 

Bft©*#£ftf/Ji3lMl. 3B£iBfa£t;TB&BftB 
0BMbt-«MBB4i3 < r*c t BBB 

l £;tli2EK©BBffl*1-f?BBBg. 

W*«4] BEB— ©B*BtkBtt)BB0f. BEff 

bbb«b<*£b» ot#s©bbbh#bebbbb 
wtoi*<D&mm\zft-?%mmg.'<? hJir&n&izm-t 
*BB«ty t>«i*e. >j*suB*B»B*aj**-*ci: 
s#ji 1 ~ 3 ©o-ma* 1 bekobir 

JfWIfSBBfi. 

[1S*H5] BEB=©B*BttBtttBB#. amB 
©^5£&»)$«* ic * BEBBB£BBtt©ttB jPB 

1 ~ 4 ©n-rtia* 1 sEeomtsffl^BBS 

s. 

[ff*H6] BEB=©fi*.HBBfcB^S#. BEB 



2 

SB£B&tt©teB#aBB©^frLTu.5BBi&>e>3 

li^H 1 ~ 5 ©Of 1 HfEB©BBB?l-BBB£ 

So 

[ii^H7] BEB-©B*B»Bm#&£j:tfBE 
m-»B*B8asaj^fs*{. BEBBB£tt«gtt;!)<aB 
Bo*ff*»*K=*u, sfcmEMttiiaimftoaB 

* h*©**si::ifins. frz>. bebbbbbbb© 

■fZ>Z\££&m4z-tZ». B*Hl ~6©ivrtlfl>l HE 

[B*« s ] as#ic«t u amis© g MNiftMttB£ 
ssiR-r s a»siji!iMt&^a«#ffi<&s ecu*, 

BEB— ©B*BttBtt¥B£J:tfBEB=:©B*B& 
Bifc^fSa*. a BBtfBEBBttBBiaitfWtiB* TPJ 
-5 fitiE a B$JIbB$£B *BtR¥l4T-SiR 3 

n^at!)*jii!)iflj!6B$. 1 =s e k u fcnofi. >jN$os*H?SHii 
*a:&T*;:<!:*»Bt*-*. k^hi ~7©o-r*n^ 

20 1 BEUOBBBttBBBBB. 

[fS^H9] BEB£BBttBBBBffi#B©Biii& 

Bic*rH\TeB«©*j»*fr5 &m%mmktt2 e»ic 

BKaii$iJ»i3MS#. BE»BBB#lBi8ffiSai¥lft© 
BitittBKiB:**, gBBIIiB(OgBBBB«HB-r« 
Ci*4#«fr*. BBB1 ~8©iv**fta»1 BEB© 
BBBttBBBBB. 

IBBBi 0] .BEanMHlBB^. BEBBBBB 

bbsbu^kobiubbcs-^*. sbbkmbbb 
1 beb©bbb*bbbbb. 

[B$B 1 1 ] BEB-OBBBBBBff tt#B««. 

a*B^e»jaBBic^ft-r-5BB«iBB!ft«;*ft»j-r-5 

B— ©MBBBB«(tttttBS&. B$uUft:BS.B£tt 

BEB— ©B*BftBm¥&©B&&B€. BEB=© 
B*B»Sm^B©»aiBB*BOTBIE-r-5C<!:£« 
B<fT-5. IS^i1 1 ~ 1 0©ivrna> I JSEK©BBB 
40 ^BBBBB. 

[S#Bl 2] BEB— ©BSBBBKBtt^Btf. 
aBfffr&jtEBC&BirSBBBBBBIteBn-rs 

%{*©&§# a bb icaos. /h $ t w&<s£ 

r*BBOB*H»WtaB«tt»il. 
BEB-©B*BBBtiiB»©Bm&B«. BEBE9© 
B*HttWaB«©BmttB*BOTBiE-r*ci:tB 
K&r«. BBB ©l\-J*fta» 1 &EB©BBft 

ttlfKBBfi. 
50 [£B©Btt&:ttB] 



(3) 
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[0 0 0 1 ] 
[0 0 0 2] 

29-^fcJ:m#P^2000-62555^fC-en-?tl^^^nTtN^) 

[0003] mmitsmmizKTz>&%\Mte<Dmmm 

[o o o 4] mi4fcct^iii5{^ mm^mmo^R^m 

mm&mrz>m3&\z&i\x. ^m.m<Dm : 7m.m\zmm-r 
^m^nux^rci^mmm^^mm^rrmmizwi 
v&/ux*i*fzm^<D±o\z. te&itmwwttezmm 
(D^^^^^mmm^^^mnx^x. b# 
iz a mn \zm& i>x < 3 ct ? /j:^^^ lt 

[0 0 0 5] 

1$£^ilJ-f££:«K lii14(C^-r^(CfctNTfi. &SQ% 

y, ^^te#^#jufcgm^ 

mmt)mi^<DtuxmmTz>z£:tfxzz>o 
m\5\z7r.-?mR. -ttz*>t>. mxtf&mm^nux^ 
%mmz£n\x. mmmmfrZM$&T%fr?Tmm<D2t\z 
w±mmt)mttz>m£i<oj:viz. smmmxizmm 
m<D*$tew^it\zftm?%j:?temnx{^ m^m 
m^mi.xn^T^^xcDmm^mm^mmzmm^ 

[0006] izrcikm(DgiW<Dm£. &%\mi*&&mm 
<D&m$iBfr e mtxx iv * s&m \z& c xm mm <t mm-? 
zfc&b. m]5iz7jkTVt : ,R\z&i,\x&. &mm(Dm%:<z)& 

M&M±lz®toty&&ttlsXl\Z>fr&>, 

mm&7£'aisxi\2>mmiz. mcomm^^^x^rzm 
m& £ mto&t&to itmtixis y , ierag« t ft rc a ««« 



4 

[0007] *3£mt±&mm\zmmuxuznrc$><D 

X\ ^©gWttS <hd^li. a*IB(c»OTP»Stti: 
tt*5mttO*3tttt«BKT*l>L BVttBSKttiRIc 
«fc6-T. WiS-C«*«i:P»»«iBBI*BIt6tr**«iffl^ 

^sissih £ set -r <s c t iz $> & . 

[0 0 0 8] 

10 n i EBtoss 1 aswri. emisicw uT«s«at«L* pi 
TEHii-r*H^*»ai-r**-<DP»*«B«Kiia^« 

<Dtt«K:*-2*. .tteB«tt«mf**Ht«tt&UTBM 
-r««**Kffl-ra«z:oP»»1fcBBI«Kaj¥«i, a 

*«sfccfctfmiE«»i*i«»»<*ottiBicjci;fc^ we* 

— ©P»*1ftB»KKaj#K-cKUJ LfcMEBB-r 

EESrr*M^4:, MEJB:z<DP«ttB»«*as^«T 
mtH UfcWEBIt-r **J^4, , DQE1R— OS»HftfftU 

*«-ewajL/tiRE»*Httt. jtiEm-om^Has 
a^ariWiUfcinEM^tttiCcty, miEi**ttM 
»**i»*«it'uTB«-r*«*o»«3|z^twaj-r* 
sttn«ttBaafftB¥«&«jix.. mEBfett&ftB 

»H4:a:****B«-r*Ci*««4:r*fcOTft 
[0 0 0 9] M««2EK0!)M2Xn(t Sil 5BH£& 

[ooi o ] 3 EKpff 3 xmi*. m i ^rcf^m 

2^[cfcOT. ME»-©**Htt»ai¥«a<. IDE' 

*i«irciaft ninsatcjEBi; 

[0 0 1 1 ] !S^ll4iEt£(0^4^B^(i. ^1 -^3^ 
W^-fnaMCfclv-C WE*— 0»*BB»»ffi^l4 

llttEKSttfR«Wff«tt»UT»&089BSn^in 
EI»»»*»i»#oa*ISilc»r**B»M^* h^flD 

50 sasicg-rs^pacfcy tffiun, /h^os^Histii^ai 



(4) 



5 

•h ■? -5 c £ £¥r& £ 1 -5 *> ro-e$> -5 . 

[0 0 1 2] Ii^Il5IHiSrom5^B^I*. |g1~gi4Si 

<Di<LSw& on. /j% s ■* Htttt * au * r « c i * « 
[ooi 3] nmk 6 tmotg 6 mm*, m i~is^ 

[0 0 14] SI**7IEtS©lg7SMIi. §1~S6S 
[0015] iSiSH 8 IEKOSR 8 gl 1 ~g! 7 16 

* -csui-r * B^rei hue a u«jnHtt>$ £ a 
s«$>ifcaift*JS!iBgjSB$*j;y t>jiufM. /jnsus*. 

H Sk ft £ JU *i f & C <fc € tt» <h f S t) <0 T- & -5 . 
[0 0 1 6] »j£if 9!EtEOTlfS9f6t!Bli. 3! 1 ~J£8fl 

©saj*sii ics-^'i a mmcomwi^'a o asb»j»#fs 
[ooi 7] a*isi oiESc©ffn oman. $ i ~gs 

9^B^wi\-r+iAMCfclNT. BuIEasi*iJSb¥S^ StliE 
[001 8 ] St^ig 1 1 IEK©§S 1 1 3SWIi. m 1 

i o^w<7)(.Nt*n*Mcfci.\T> tas&m-omwmmmm 
muf-naMm^sttonoi^n&m ^xmjEt z> z £ z& 

[001 9 ] fimil 1 2 £K©S 1 2 fgBSIi. 31 1 ~m 
1 1 I^Bflroo-r'ndMCfcUT. mJlEffl-©P§g%iSiteg 
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iE^-»s*MStsai^K©saim^^. mzmm(Dm 
*H»nm¥«oKmttJin6ffl i^T»iE-r * c <t 

'<!:?-*t>©Tfc*. 
[0 0 2 0] 

[fgBflro&n] si i nmjicjcncr. &»iUfcRm#i£fc 
io itt<*©i«lg'<i' h.»u©»6>c«-3<a-Sc. a^ii 
lt. saik7t#P8«&K!S£^n^nic*tu ^©s 
mzm&m&mzmc* mt>tifzm^mmm^t^>z.£ 

R«1fc<hft-5a>SA>©Bia£fre>o -^©Ac 

[0021] ^2^wic«tntf. ^is#n*<tes 

Kl»©fii£. fltjlEtiJFt^g^^ h;M73*££#/Jx£lM5 
t*/hS < 73: -5=t 5 \zmm?2>Z. ££ LTU5rcfc, S/N 

[0022] m3^^icj:n(f. mwwimmvm£&m 
m£<o^m^^ hJWJjftizm^TntiiT&w.*- 

|S]CD*B*tgg/£-tficy-f XA«*at3'5«fc5/d:li^ WtB$ 

wm%$im.<omm.*:ft±i£i±z>z\£tfiuim£ti.z>„ 

[0 0 2 3] ^4%W|c«fctXlf. KtUr-Slff 1 fc=fctff& 
40 IMI^IC. mi ©!i*lia©{I^/h$<. -^2<DM 
[0 0 2 4] ^5^|c«i;tllf. H 2 ©S*-§8St#. ^ 

a-r* am*s©f?i*WLS):ic5FtLTRStt<g«!ti5#ro{itg 

mS«r |S|± 5 -tt 5 C i: tfi Plfig <h ft S o 
50 [0 0 2 5] m6^W|c«fctl(f. ^2©S*Kai±. m 
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[0 0 2 6] SfT7SBWlC«fctltf, ttftL£RS4«l««« 

fci6UfiHlT\ *^Jl*lc#ftr-5»^. WCttBIKK 10 
<£>ft£ £ ft ± 5 tfr 3 c £ # pT &g <t ft Z> o 
[0 0 2 7] »8*«fc«fcntf, S$«^S«)ii« 

s -esja-r « <t znzmm tfi. be* ic j: 
tJtttUT*i\a- sri fc«fctfss2<Dfi*w«ffi 

^IBttt* title. iie*fc«fcy, aK*4)&*ic$o 
/ti»*J»*S14*»S"r-5Cc!:^prfiEift-5. 2Q 
[0 0 2 8] *9BWK:J:titf % BttBSWEHKlia] 

*«icj:ui«asftfcisjii*, a»*j»#iftfcfctxTB 

BS«itftS^SEttOfil^«:|C«OTIiMO^U- + 
^^t>ftt>C<t<hftU, B»1&BMmcj£C*:iB«lft 

[0 0 2 9] £i OfMIHcfctitf. flfcttRSttiBttftff 
ir^di^S. WStttft^pIllEftOfit^ftlcWO 30 

ff z> c £ # pj# e t ft -5 o 

[0 0 3 0] SBi l fccfctfSS 1 2 58WlcJ:titf. e*BS 

#£<hft<5o 40 
[0 0 3 1 ] **WIC«fc*»Bffltt»E««»cfcl\T 
14, 4»ttOMft«R*«lBK^IItb^««R(t. -Ml* 
noR»*B«a»tb¥«lci3l\T»mL*:R**B«l 

BBiat^iO^ciiLTt^*. 
[0 0 3 2] RS»B»flE»ai¥«tUT, S««ilC» 

uTB«^*«ft«wmr**afij;tf, 
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SfCgo*#, niBRSilSMItti»«RS«^LTBtt'r« 

TU/cfilW, S*IB©£fT*»lClijya^*;fc 
»^<Dcfc5t, tt«(4R<ttl<i:ft:«?rflgtt(DftSttftM 

at«*UfcR8«iBI«*(DKai*ff5CilcJ:y, 

10 0 3 3] ^^H15(C^-rctpft, BWJW*j£frUT 

<t icj: y . »*n«ittAtRS«9 i ft * piffitt * J: u aos 

BT» * d <t # nlffi <h ft £ . 
[0 0 3 4] ^SRSttBs«t«<7)KasiC33^T. 

srcwuT. ^■r+i<o»tB*s£*«aLTBa«-r^*^ 
<k re 4: y wwrr a. -t-nrcj: ^ tj: y j£»Bfc«Kic« 

OTIEW^ajSfcRS«i(OB«l$fTPCt^T#Sck 
P lcft£>„ 

[0 0 3 5] 

[5BWG>5ISS<BJI2«t] JUT, ai$^BLT*SW©ff 
jgftHffi^^lCOt\Tlfe^-r-5o 
[0 0 3 6] Bill* Mnrc«fc«Sliffl>MfBH»B 

(4. BX«iMS2fcff«E-r^RStt«l4iOttB«tt«pLT 

a4**rsR*««iftttaas*wioK B*woass<^ 

■^tiRftS^JSldcfcy. fc*QU£RS4&«ffi#R§^<!: 

<c«pnKtt«s-rRSttBHa«^»«»— oRSttB 

£,fctfff-<0B*Bft]fCtiS1O6. ctigRSMSMft 

wajwfc«fctx«*H»iia»«fcy*n-etiai*5ti>ttt 

[0 0 3 7] 0214, *BBlcJ:«XKM^ffBWKB 

0^<O*>^^A(4. SffSJfflSBZOU U-tf 
^'202. U-^«nKB203, CCD^>^204, MftlR 
S205, *2^dti^g206. &ffcft&&mW2Q7. gKT' 
U-^*J^)^M208fcJ:^fei±^*U- + ^'-x^209^A 

[0 0 3 8] !f U-^202(4, U-tf 



(6) 



mm^m i/-*-*/ui£im203t- 

[0 0 3 9] — ^CCD^^^204t)^^miSfu^^^^ 

atttu ^<D&mtM&mmmw2Qs\z&j£zn2>c z. 

^mmm2Q3TMth^rzmm^m^co2:x7tmm 10 

^tLTP^fy. ftmoi^-ftuz&zfr. t&nTtummy} 
mm^^^mm<o^mm±izn^T^t}^t}^w2M 

10 0 4 0] is-?'mMmw2Mt5£zfimmmmmw20b 
frt>&t)znz>T-* it^i=f^mmm2Q]\z^0^n 
*o *fzmmfe&mw2{}^ ^n^^m2^<o^ti'e 
ti& e> &t> £ ti * * t>^f7*j»s«2oi iceat $ n 

urn**®. *fo«*icjci;fc«iaiofc»o«^ (an 
[oo4i] ^ft»j?»s£«2oi^t>(Das^(i^'iian^ 

U-*9JfflSB208lCjKe>ft£. an:/l'-**J1M!«2 
08»i*«S9lW»lifC»(t/tftff^ f U-*^-X^209t 

iiu *Mo7u-^cmittan^u-4'M*KB2o 

8^6(O9Jn*«*f8EE*<«-ftS^ r U-*^-X^209(O 
[0 0 4 2] MM*. ^fr»JaiSI«201T^)|»S«lSlttJS 30 



ffi»103TI4»-(D»*1*E»RRK Si:i0B*ttlBtt 
a»aSffl104-Cfi»-<D»S«lKMKR2. Wi-<DMfrM 

asfflio6T(*a-o[)a*BBaw2«:-t-niE r n*«)«>, *o 
Ttt-ommniaRi t sB-©«*Hawi 4<d«ri x 

Wh W=a>P»«MBMWR2&lll^S»mkW2&0[)8IR2 
xW2£*«)£o -tUT««»*«lB«IK»aW107T 

[81] (R1XW1+R2XW2) / (W1+W2) 

*<Dtt«msttttB*ttBKK&-r«. 

[0 0 4 3] S4I2. *56Wlc<fc*»tfiJfm»BMSgB 
iCfcOT, U-lf U-# r 202^e>OMffi-7 i -^lcK-^l\ 

sit, ^(D^imzmw-fZo tz*$, ccm 

[0 0 4 4] *t*X^y^301-eii, 



40 
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»*eft*aas«207*6(Da*«<oanKft7 s -*(Dfte; 
j»E#A<ff«-ca«Ltean^u-*»f¥^-f 5>y. 

k& 3 -ft) fe«fetfe»(OJB« (A*) ^^nfnA 

[0 0 4 5] a<^^y>^302-C(i. ^xy^OITA* 

[82] y-j8 Z/ (Z-a) • u 
0 = 1 - a 

£ftA7r£>^8£, Z»l«nS*XIV7. yli¥;t<b& 

[0 0 4 6] Xxy^303TI*. U — if U-^202^&O 

^y^OS^itt/. fc*3. CCTIil/- tf \s- ^202^6 
© ffi 5*- * <E>JE$ff (4 1 0Oms^ ICfrtotlTl * -5 *> O £ L 

[0 0 4 7] X^y^304Tli* U-tf U-^202T^a 

mmztsv&iSLm&vtfr&fr* ^<X7-yzfzQ5xitm 

[83] G(Z) = (cZ2 -c)/ (Z 2 -aZ + b) 
CCT% Zf4J6*at»TT*U» Ma, b, CI4IE8 

safe, «si*«««i#ors»^iffai«s«i*ti 

[0 0 4 8] X^^y306T(4, X7 & ty^304TR»i&^ 

«Tttl\»6lCttX^y;/308^iiti\, 
[0 0 4 9] ^^y^307T(4, ^7-^^304TR»^ 

Taprfi]*OICU-by ht^ e 

[0 0 5 0] ^^-/7308-rii, >l5 t y^ , 302T 3 F»<t« 
S^fro^m^ (Vsp) <hSff£ft (6) (Z)ffi£EH\T. 

[84] 



(7) 
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CICT. ffi»ml««;G>M, Kf , K r itttl^tlwi 
'&m*«(*<D^-+V If, I r B-tn-e 

S207^e> a* L^-r-^^Eig a- hfa<t ut^ 
i*Tt>fi<. *^«i»»iRiiipss*-t>'S-fccfcvai*iDiiio 

y:/ft0£3£a&£c<h<fcUTt>SO. .10 
[0 0 5 1 ] A-5ry^309T(i. y ^308^**0/^3 
-l/-htX'Jy^ feitf^^y^302T*«>^* ' 

lift si 

R=Vsi>/tf (Vsp>30km/h<£>*§<&) 
R= (1 f + ] r ) /fl (Vsp£30kn/h®«£») 

[0 0 5 2] XT-y^310Ttt, A-5ru/^304rSI*^ 

6, ffSttttffitttttiOtttttt 20 

[ft 6 ] di rect ion_C [i] =arctan (obst_x [i] /obst_y [i]) 

[ft 7 ] di rect ion_L [i] =arctan { (obst_x [i] +obi_width 
[i]/2+w/2) /obst_y[i]) 

(O I DIM, ffKobsLx [i] (2IV«4«iffiti«9ttC> x 
ffi»obst_y[i]fi»S«i«»*»©yffiS, ^ftobj_wid 
•th[i]tt»*»«««rtt(0«. Sftw»a*«i(D««-C- 30 

[0053] mz. amic»r«i««*fRMmi#a>« 

[ft 8 ] di rect ion [i] =arctan (rVx [i] /rVy [i] ) 
t>. ffiMXK^^ hJUO«MlcSrf<n«*BKK (Ml 

[ft 9 ] Recog„rVxy= (-0. 2/f abs (d i rect i on_L [i] -d i rec 
tion_C[i])*fabs (di rect i on_C [i] -d i rect ion [i]) +1. 0 40 
lCcfcU*i£>^ 0 CCT^ftrVx, rVyli A^y :7305T*: 

■eft u . nttf abs (x) mm x ofettttetttoSHflt? 

£>3o S^KttReco8LrVxyttHSM«l4t«iff^g*«ilc 
[0 0 5 4] A5^;/ ^311X1^ 7x y ^309TS£h L/c 
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SIS) £3fc<££ 0 
[ft1 0] Recog_Dist= (-0. 2/w/2) *fabs (hypot (obst_y 
[i], (obst_jc[i]-R))-R)+1. 0 

CCT\ Htthypot (pi, p2) it, ?lftp1. p2ci: U (pi 2 +p 
22)i/2 o'§|«*«ftt>or««.'ftfi. ^ftRecog. 
D i s 1 1> * fcB*4MR«Mfcft«f g SIS ic 4 o Tf$ WW £ U 
£pjffitt;&**£i*#lc!i0. 8-1. 0<&tt£»y , «^/J\S 

[0 0 5 5] A^y^312TMi, JUT!cKWr*¥JOIIC 
«fcU, ^yy^lO-T***:*— ©BSttBBKlcWt- 
£31— 0»*BB»*5<fctf, 7Ty^311T*^azfl!) 
WSttBBKIcW-rsW^^BfrrtBt-tn-^ti** 

[0056] £-r\ ^^yyaosT^a&fcfflwaa^^ 

hJUrVx, rVy<0*£$a>&, »aic J: U S— OM*B8» 

[ftl 1] tmpW1_1=f unci (f abs (rVx) , f abs (rVy)) 
CCT\ func1fiH5IC*-r«t'^«:*#tt€:*-r*H»Tfe 

#\ ^-<^m^Kft^^i«Mfc^:^<-r^cfce)(cLTt ) 

fit*. 

[0057] $>t, m-~(om&M%L<D*bz>--'D<D*pmm 

tmpW1_2£«StfCcfc U ^#><5 e 
[ftl 2] tmpW1_2=func2(Tapr[i],Tds) 
CCT, func2ttBBfC3Rr«t5<t«tt**-r*B*T» 

y , MfcTdsii*©;*^* ^305icfe(t-seaBaaic j: u 

Jg~(Dm^ftcD{i£*ittlfilC*#< LttfiO. 

[0 0 5 8] Jfclc, *-<7)M*Bao— OO^BltttmpW 
2J**3SlC±y*»* 0 

[ftl 3] tmpW2_1=func3(fabs(hypot(obst_y[i], (obst 
_[x]-R))-R) 

ccT\ func3filH7 lz*-r«t 5ft«ttt*-r «HBtT 

[0 0 5 9] «-*3«ttfBroB*M»ic*r-r 
a*M«.tBPWi2j**a«ty*«>*. 

[ftl 4] tmpWl2_1=func4(hypot{rVy[i], rVx[i]))*fun 
c5(obs_io, hypot (obst_y[i], obst_x[i])) 

obs_io=obs_pos-hypot (obst__y[i], obst_x[i]) -h 
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obs_pos=hypot ( [p cos (y) -obst_x[i]), [p sin (y) obst_y 
ti])) 

CCT\ func4, func5l*-€-n-f*lB8, B9lC*-rcfc?fc: 

»tt**-r*Bsa-c*y. eapii^y^oi-csw) 
(ccr(*^«*iEtf*) . yiiaaic«-r*a*iB 

y, tmpW12_1£){ii(i. *»tt««tttt#ff±LTl*«Pl 10 

sua, /hauffl^ixsctt^s. 

[0 0 6 0] <*£|C. SK-fccfctf*-©B*B8»lc»T 

[815] tmpW12_2=func6(Tc, obst_y [i]/rVy [i] ) 
Cut, f unc6(£B1 OIZ^-T <fc 5 fc**tt*W-r SHST 

*y. saTcii*i£**«»*-cajRT***j«iH*ft^-f 

5>^*SU ccm 0iJ*_ff : 1. 8sec. 20 

* : 2. 4sec, S : 3. OsectfS.' 
[0 0 6 1 ] lU^tDctpfCUX^to&tlfe^tl-rtlOffi 

M^HKWI. W2t*ti-€ r ti»StJ:y*«>-5. 
[31 6] W1 = tmpW1_1*tmpW1_2*tmpW12_1*tmpW12_2 
W2=tmpW2_1 * trapWI 2_1 * tnpWI 2_2 
[0 0 6 2] *UT^r-yy313Ttt, ^^^^310fe«fc 
y 731 1 "C-tti*tl*»fcl»»«lB»*0« £ . 
X^*:/312T3R»&a*Hato«J&>&* m&mtemm 

SC-(M¥^) lcJ:y*»*. 30 

mi 7i 

Recog= (Recog_r Vxy*W1 +Recog_D i s t *W2) / (W1 +W2) 
[0 0 6 3] SaiCX^;/ 7314TfdU 7302fc;fc 

it* wfeitmnis £ v ^305 ic 6 * esHas 

«««*IC«-r*KaTapr[i]©««r-!t>^y >^«IB 
T**10ins#fcM*i«inStt*. 

[0 0 6 4] ja±(o«i3i¥wrccfcy. VMRmni 
cti6fc*ft-en»*u&«ao«*wa 
ftRftu «Kicj»i;T«*natanaic3fe3i-r«c4: 40 

[0065] aiitt. *fmte**wmmfMwm*m. 

iCfc^T, tfU—^202 (B2#&) fccfctfCCD* 
*ao*«ftffltx^ii^<Ol»»«lBaiK**«)*4Dr31# 

n*st7P-ft-hT**. jut, "toim&zmw 

CCT*fcfflS£10msSlCfr?C 
[0 0 6 6] ^•rx-^^^501TfiCCD^^^Oit5^JT r - 

Xx*>y502^, K«2ftTOftttntf*^ 3/7506^51 50 
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[0 0 6 7] X^s/7502TI4, CCD;*J*^TfflHftU£:ffi 

«is«i6«^6ttau>taa<o»stt«*%»(0 2»7c 

14* tt*a^«#»S««««H»<Dffi«^&. 20msCD1t 

>y u >^ninTMttftLfcfiSHa«ffii\Tffi»isa 

^ hJlo€3}ct&«. fcfc, CCT7BOSe«Hai4. B 
[0 0 6 8] X^y:/504Tf4. *^y7502T«*i^ 

[0 0 6 9] *Ty?505T*l*s X J T-y75Q2T*Wtfr&/u 
«#P»*««««»» let J UStrcl D#-5§ ( i ) fC^lt 

fc, »Hsw««i«i«^ai3KUT^e(D«n«s-rKa 

TaprJlMR[i]£0 fcy-fey h^T*. **< J*^.y 7506--;* 
7- * 751 OlCfc (* 040*7^;/ ^303~307thl5l 

[0 0 7 0] X^^^511Tli, *^*;/7503"C2£«>y*:. 

lessors— (B««ttB»ft«:*«>5. across 

(4H4<DX^y7310<!:Ht$-Tr*£*:«>. BWJ(4«Brr 

£«-0ffS#lBKX<Dttr4» ^aRecog_CMR[i] left A 

[0 0 7 1 ] X^;/7512TI4. *^"y7508T3Ra&*:, 
U-lf U-^ r 202O^3S7 : -^lC«tSffl*taS^^ hJU 

fc»jE6^-«IB-o»*«iBIII*Ofit!i, ^aRecog_LR 
[i] icftAStt*. 

[0 0 7 2] X^^^513T(i, JaTfCKWr**«(C 

wsttBMKicwrsaEgfloa^Hat-tti-en**) 

[0073] ^^y^503-c«»fc«»aa^^ 
h;ucoffi^e>, »=<DK*Hao+Bnatrapwij m fc^ 

tf»E30a*Ha© + ratttmpW2_1 [i] ft-tti-ftl*^ 

[0 0 7 4] afcic. * = ©«*Haot>5-oo*tiBHl 
tm P wi_2 [i] y 

mi 8] tmpW1_2[i]=func2(Tapr_CMR[i],Tds_CMR) 
CCT\ func2fiB4CD«i^WSOX^u/^ r 312TfflO^: 
HatHCt>(OTSr«. ftfe. ^aTds_CMR(iCCD^>^ 
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[ftl 9] G(Z) = (cZ 2 -c)/ (Z 2 -aZ+b) 

SS-ro^PJ^SU, CCTI44Oms<0--j£tt*fl*4. 

[0 0 7 5] R«|C % JBffl(0M*H»®fc5-:3O*M 
<[StmpW2_2 ti] fcJJtfClc J: U 

[S2 0] tmpW2_2[j]=func2(Tapr„LR[i],Tds_LR) 
ftfc. ^ftTds_LRI4U — !f U—^202 (B2#«a) (D^fi 

func2(i04OfflS^liRlcfcft*t)(Dtra'i;BBiS-e**o 
[0 0 7 6] CCT, »S!ft^a*ML/- tfU-^20 

[ft2 1] tmpW1_3 [i] =1, tmpW2_3[i]=0 

"s >c . m m*fomm% ##ccd* > ^ 204t-i4***qt- # 4 *« 
u - tf u - ^202T(i«»T* u i \ ? tiizn ftWdflC 

ft<0 + Pafil£3Ri£>4 o 20 
[.82 2] trapW1_4[i]=0, tmpW2_4[i]=1 

[0077] a±<o^*«fcy 6." 

««li*lC-»/£^^SHfccttfaEg(Z)«*B8ittW1 [i], W2 
[ft 2 3 ] 

W1 [il =tnpW1J [i] *tmpW1_2 [i] *tmpW1_3 [i] *tmpW1_4 [i] 
W2 [ i ] = t mpW2_1 [ i ] * t mp W2_2 [ i ] * tmpW2J [ i ] * t mpW2_4 [ i 3 
[0 0 7 8] XT-yJSU-Vtti* ^vysute&lt*^- 

[ft 2 4] Recog[i]= (Recog_CMR [i] *W1 [i] +Recog_LR [i] 
*W2)/(W1+W2) 

[0079] XTy-Jwvu. fcmM%L'Mmm&'i=T? 

ICfcfT 4 ^ftTa p r_CMR [ i ] , Tap r_LR [ i ] <om £ V > 7 U 

[0 0 8 0] £t>lCX^:y:/516TI4* X^y^SHT* 

9PSB208 (B2*S» ICfc(*«B«a»Kt»aic«fcU 40 
2£#>4<> 

[ft 2 5] abrk=Recog[i] 2 *(Vp 2 -Vsp 2 ) / (2* (L-Lt) ) 
CCT*VplJ*fr*«5<DaE, Vsp(4gJilil031g£^ 
U VD<&ffil4ffi»iSSrVy£ VspOftcfc y 3t£>4 t><DiiT 
4. *fcLI4fcmo/t*MeB*\ Ltf4SflUKHEtt«: 

[ft 2 6] Lt=1. 5*Vsp+4 

[0 0 8 1] Z(DJ:o\ZLTmfttc.abrk<Dimzm-3^ 
X. e»yu-*«»SBB208 (B2#HB) lz«fcue»^ 50 
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[0 0 8 2] aW7\s-*&mKte4"(£># 

icj:y*»«. 

[ft 2 7] Tbrk=func7(Recog[i]) 
CCT\ func7(4H12<0«t^«c*S , tt*Wr4HftT* 

[0 0 8 3] £blC, ;^itC0^^S$nTO41i^ 
ictt. ±EoaS3«aKobrk^attyu-**JWKI12 
08^ai;*j£tl4o 

[ft 2 8] L/(Vp-Vsp)<Tbrk 

[0 0 8 4] UT*d&fcTbrk<0ttlc»:2l\T\ g») 

ttfty, JSS^&y 5 40\ «Tfcl\0>£*UKU 
■ll^»»IC«UTI4*a6©a»^U-*»ft*fftotl 
4, -r«:*)S*Sg*-CcOB$PJ^jgiX4Ct<!:^:y. 

[0 0 8 5] tt4s, H»func7©«tt*H13©J:5(cK 

«-T4d:. aibyu-+nf»0E)iHft^x<fty. *tuc 

P»S#I <h is. y 5 4 3&»S fr'Z n%i*"r 4 H$ Pb1£ ft < f 4 c h 
[ B 2 ] 9) |c J: 4 mil ffl fl^BStSS * ffl t * Jt.-> 

^^rA^rftoWfiS^aft^-r^py^B-efcs. 

[B 3 ] *iS«T(DP»«1*lB«*OJtai^JIIS«:«»S 

[04] *s»ic*>ot. u-if i/-y*6©aef 
ic»^t\TP»»«B«flr**»*«3i*jii*«-r 7 

□ — 3^1*- hT£>4o 

[B5] B4(Dffl:SfCfc(t4, m-(DM^IIft<^^P B 1 
4o 

[B6] "B4©«afcfc(ta. m-cos^^ftofc^ 
[07] B4o«i3ifct5rt4. *-coa*BB»(D*pa 

4o 

[08] U4^lilcfc(t4, S-fccttXS-OS*- 
H»IC»-r4*PJtt**«)4^:«)<0BBftfunc4<0«14* 
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